#include <WayPoint.h>

WayPoint wp1(0,0);
WayPoint wp2(0,180);
WayPoint wp3(90,0);

void setup()
{
  Serial.begin(9600);
  Serial.print("Distance beween (0,0) and (0,180) should be half the circumference of Earth ( ~20 000 000 meters ), and is: ");
  Serial.println(wp1.dist(wp2));
  Serial.print("Distance beween (0,0) and (0,90) - north pole - should be a quarter the circumference of Earth ( ~10 000 000 meters ), and is: ");
  Serial.println(wp1.dist(wp3));
}

void loop()
{
  
}
